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Abstract — In  this  paper,  the  control  problem  of  utilizing 
a  team  of  autonomous  marine  vehicles  (i.e.,  tug  boats) 
cooperating  to  manipulate  a  larger  floating  object  (i.e., 
disabled  ship)  while  operating  in  a  decentralized  architecture 
is  considered.  After  decomposing  the  problem  into  several 
phases,  a  control  design  targeting  the  issue  of  inducing 
controlled  rotations  for  the  manipulated  object  is  presented. 

I.  Introduction 

Swarms  -  large  groups  of  relatively  simple  and  cheap 
robots  working  in  concert  without  a  centralized  decision 
maker  -  have  been  a  popular  area  of  research  over  the 
past  few  years.  Land-based  mobile  robots  are  the  most 
typical  type  of  swarm  considered  although  some  work 
on  unmanned  aerial  vehicles  (UAVs)  have  emerged  in 
recent  years.  Most  of  the  current  literature  considers 
using  the  distributed  sensing  capabilities  of  the  group  for 
reconnaissance  and  information  gathering.  In  contrast, 
few  works  actually  address  the  issue  of  how  swarms  can 
influence  their  surrounding  environment. 

The  goal  of  this  project  is  to  allow  a  single  human 
operator  exert  high-level  control  of  the  on-water  ma¬ 
nipulation  of  large  objects  using  swarms  of  autonomous 
marine  (surface)  vessels.  On-water  manipulation  of  large 
objects  by  a  swarm  of  small  autonomous  vehicles  is  a 
novel  area  of  investigation  with  naval  applications  to 
marine  ordinance  disposal,  transportation  of  disabled 
ships,  and  assembly  of  large  marine  structures  such 
as  positioning  sonar  arrays  for  littoral  surveillance  or 
construction  of  off-shore  platforms  and  bases.  Aside  from 
these  direct  applications,  the  methodology  developed  will 
have  indirect  application  to  land-based  robot  swarms, 
swarm  reconnaissance  and  exploration  missions,  and 
micro-assembly  tasks. 

Distributed  manipulation  is  a  topic  considered  in  the 
robotics  literature,  although  it  is  generally  limited  to 
kinematic  analysis  of  small  numbers  of  robots  with 
centralized  decision  making.  In  addition,  the  authors  are 
not  aware  of  any  work  considering  the  unique  dynamics 
of  marine  vehicles.  A  rigorous  second  order  dynamic  anal¬ 
ysis  of  controllability  and  manipulability  issues  related 
to  pushing  objects  with  single  robot  is  presented  in  [6]. 
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Fig.  1.  The  small  gray  ovals  are  autonomous  marine  vehicles 
which  manipulate  the  unactuated  larger  green  floating  object  (e.g., 
disabled  ship)  to  the  goal  position. 

Dynamically  manipulating  objects  using  two  or  three 
robots  was  examined  in  [8]  and  [7].  In  both  cases  it 
is  unclear  how  to  extend  the  methodologies  to  many 
robots  with  decentralized  decision  making.  Perhaps  the 
most  relevant  literature  to  this  proposal  is  the  work  on 
“caging”  -  using  a  relaxed  version  of  form  closure  for 
cooperative  manipulation  -  presented  in  [9],  [10]  and  [11]. 
Controllers  are  designed  which  force  robots  to  surround 
the  object.  Inter-robot  spacing  is  constrained  to  be  small 
enough  that  it  is  impossible  for  it  to  “escape”,  meaning 
that  as  the  robots  move,  so  must  the  object.  The  primary 
drawback  of  both  these  approaches  is  that  they  are 
strictly  kinematic  analysis.  The  extension  to  on  water 
manipulation  requires  consideration  of  hydro-dynamic 
forces,  non-negligible  drift,  and  disturbance  rejection. 

The  outline  of  this  paper  is  as  follows.  After  a 
discussion  of  related  work  below,  an  overview  of  the 
problem  is  given  in  Section  II.  The  problem  is  too  rich 
to  be  considered  in  its  entirety  here,  so  we  choose  to 
focus  on  the  sub-problem  of  controlling  the  orientation  of 
the  manipulated  object  in  this  work.  A  formal  problem 
statement  appears  at  the  end  of  Section  V.  A  robust, 
decentralized  control  strategy  for  each  swarm  member 
is  presented  in  Section  VI.  The  stability  analysis  for 
the  developed  control  design  is  presented  in  VII.  The 
conclusion  and  future  work  are  presented  in  VIII 

II.  Overview 

The  problem  we  are  ultimately  concern  with  is  shown 
in  Figure  1.  Given  a  large,  unactuated  floating  object 
with  position  and  yaw-orientation  77(f),  and  a  desired 
position  and  orientation,  r/d(t),  utilize  N  small  au¬ 
tonomous  marine  vehicles  (swarm  members)  to  affect 
the  motion.  The  general  problem  can  be  decomposed 
into  the  following  subtasks. 
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1)  Establish  Contact:  The  location  of  the  initial  po¬ 
sition  of  the  members  is  arbitrary  so  they  cannot 
manipulate  the  object  before  making  contact  with 
it.  Robots  must  select  and  move  to  some  point  on 
the  perimeter  of  the  object. 

2)  Rotate:  Large  objects  such  as  ships  have  a  prefer¬ 
ential  translation  axis  due  to  drag  and  added  mass 
terms.  The  robots  must  rotate  the  object  until  this 
preferred  moment  axis  is  aligned  with  ( q d  —  q) . 

3)  Translate:  Execute  a  pure  translation  of  the  object 
from  the  current  position  q  to  the  destination 
position  qd- 

4)  Rotate:  Rotate  object  from  current  orientation  if> 
to  the  destination  orientation  ipd. 

The  topic  of  obstacle  avoidance  is  not  considered  within 
the  scope  of  this  paper.  Rather,  we  will  consider  issues 
associated  with  Phases  1,  2,  and  4. 

III.  Contact  Considerations 

In  the  typical  dynamic  positioning  or  dynamic  tracking 
problem,  the  motion  of  a  given  vessel  is  to  be  controlled 
by  a  given  set  of  installed  actuators  (propellers,  rudders, 
tunnel  thrusters,  azimuth  thrusters,  etc.)  The  dynamic 
characteristics  of  the  vessel  are  assumed  to  be  known. 
Actuator  locations  are  usually  fixed  by  vessel  design,  and 
actuator  forces  are  well  modeled;  hence  the  control  effects 
of  actuators  on  vessel  surge,  sway,  and  yaw  motions 
are  consistent  and  fairly  predictable.  The  solution  of 
this  problem  involves  finding  the  set  of  control  inputs, 
generally  the  set  of  actuator  force  magnitudes,  directions, 
and  sequences  to  achieve  a  desired  vessel  motion. 

Our  work  involves  the  more  general  problem  wherein 
actuators  are  not  at  fixed  locations  on  the  vessel  to  be 
positioned.  In  our  work  the  actuators  are  separate  vessels 
(tugs),  which  exert  forces  on  the  vessel  to  be  moved. 
This  scenario  brings  additional  degrees  of  freedom  to 
the  problem  through  the  ability  to  position  the  actuators 
along  the  ship’s  waterline.  These  additional  degrees  of 
freedom  allow  for  further  optimization  of  control  forces 
beyond  that  of  the  typical  problem. 

The  force  interface  between  the  tug  and  vessel  imposes 
constraints  on  actuator  forces,  as  actuator  force  direc¬ 
tions  may  be  constrained  by  achievable  tug  orientations 
or  by  differences  in  forward/reverse  thrust  capabilities. 
When  the  tug  is  not  connected  to  the  vessel,  the  only 
allowable  actuation  force  is  a  combination  of  pushing 
and  friction  forces  between  the  tug  and  vessel.  Slipping 
between  the  two  is  undesirable  in  that  it  changes  actuator 
location.  If  slipping  is  to  be  avoided,  the  tug  thrust 
component  parallel  to  the  vessel’s  waterline  must  not 
exceed  the  static  friction  coefficient,  or 

sin  9  <  ns  cos  6  (1) 

where  6  is  the  angle  between  the  thrust  vector  and  the 
normal  to  the  vessel’s  waterline  and  ns  is  the  static 


Tug  1 


Fig.  2.  Illustration  of  swarm  forces  on  disabled  vessel. 

coefficient  of  friction.  The  maximum  allowable  value  of 
8  is  therefore  given  by  the  following  expression 

^max  =  tan  (/Ts)  (2) 

In  such  cases,  force  direction  is  limited  to  the  normal 
to  the  surface  and  the  range  of  angles  near  the  normal 
for  which  friction  is  sufficient  to  prevent  the  tug  from 
slipping  significantly.  A  likely  scenario  is  illustrated  in 
Figure  2,  for  two  tugs  not  connected  to  the  vessel  while 
controlling  vessel  yaw.  Force  directions  are  limited  to 
the  normal  vector  to  the  waterline  n/  ±  9.  Tugs  may  be 
positioned  along  the  vessel  waterline  except  where  vessel 
structures  prohibit  pushing,  such  as  the  propeller/rudder 
area.  The  net  torque  applied  to  the  vessel  is 

N 

Tnrf  =  ^  Ri  X  Fi  (3) 

i=l 

Optimization  of  tug  location  to  maximize  available 
torque  to  control  yaw  involves  maximizing  (3),  subject  to 
hull  geometry  and  allowable  force  directions.  A  similar 
optimization  process  for  the  net  force 

N 

net  =  K  (4) 

i=l 

is  possible  for  surge  and  sway  motions.  Overall 
surge /sway /yaw  control  can  be  optimized  by  simultane¬ 
ous  force  and  torque  optimization  subject  to  the  above 
constraints.  When  the  tug  is  connected  to  the  vessel  with 
lines,  achievable  actuation  forces  are  no  longer  limited 
by  friction.  However  tug  locations  will  be  limited  to 
the  available  connection  points  installed  on  the  vessel. 
Additionally,  although  a  wider  range  of  actuation  force 
directions  is  available,  changing  direction  may  involve 
significant  time  delays  due  to  the  time  required  to  change 
the  relative  orientation  of  the  tug  and  vessel. 

Our  generalization  also  brings  additional  uncertainty. 
Whereas  the  focus  of  the  typical  problem  is  the  vessel, 
whose  characteristics  are  well  known;  this  work  involves 
the  positioning  of  an  arbitrary  vessel  whose  dimensions, 
mass,  hydrodynamic  coefficients,  and  other  character¬ 
istics  will  be  uncertain  or  unknown.  As  a  result,  our 
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work  is  centered  on  a  group  of  tugs  whose  characteristics 
are  known  and  which  represent  the  majority  of  known 
characteristics  in  the  problem.  The  identity  of  the  vessel 
to  be  moved  may  not  be  known  until  the  tugs  are 
assigned  to  move  it. 


IV.  Contact  Model 


Once  contact  is  established  with  the  disabled  vessel, 
the  swarm  vehicles  appear  in  essence  as  independent 
azimuth  thrusters;  therefore,  the  three  degree  of  freedom, 
kinematic/dynamic  equation  of  motion  for  a  disabled 
vessel  operating  in  a  body-fixed  reference  frame  and 
actuated  through  N  autonomous  vehicles  is  governed  by 
the  following  expression  [3] 

v  =  R  (VO  v  z,.', 

Mv  +  C  (v)  v  +  D  (v)  v  =  Bu  K  ’ 


where  the  vector  77  =  [  a:  y  7/  ]T  G  denotes  the 
inertial  frame  position  and  rotation,  v  =  [  u  v  r  ]  £ 

R3  represents  the  body  fixed  translational  and  yaw 
velocities,  the  rotation  matrix  R(ip)  £  R3x3  that  relates 
body  fixed  coordinate  system  to  an  inertial  coordinate 
system  is  given  by  the  following  matrix 


RW 


cos  ip  —  sin  ip  0 

sin  ip  cos  ip  0 

0  0  1 


(6) 


M  £  R3x3  represents  the  system  inertia  matrix  (in¬ 
cluding  added  mass),  C  (v)  £  R3x  3  denotes  the  Coriolis- 
centripetal  matrix  (including  added  mass),  D  (v)  G  R3x3 
captures  damping  effects,  B  £  R3xAr  denotes  the  swarm 
configuration  matrix  whose  ith  column  is  given  by  the 
following 


thrust  input  iq  (t)  such  that  ip  (t)  tracks  a  sufficiently 
smooth  desired  orientation  trajectory  ipd  (t)  £  R1  (i.e., 
ipd  ( t ),  ipd  ( t ),  ipd  (t),  £  Lao).  To  this  end,  the  orientation 
tracking  error  signal  e ^  ( t )  £  R1  is  defined  in  the 
following  manner 


=  [  0  0  1  ]  e,, 

en  =  Rt  (ip)  (77  -  r]d) 


(8) 


where  ev  £  R3  represents  the  3-DOF  tracking  error 
signal.  In  lieu  of  serparating  out  the  yaw  dynamics 
from  the  translational  dynamics  of  (5),  the  orientation 
tracking  controller  will  be  developed  in  terms  of  the 
3-DOF  tracking  problem  with  the  orientation  tracking 
control  input  being  extracted  from  from  the  3-DOF 
control  input  vector.  In  addition,  the  swarm  thruster 
control  design  will  assume  exact  model  knowledge  of  the 
disabled  vessel’s  parameters  (i.e.,  M,  C  (v),  and  D  (u))  as 
well  as  full  state  feedback  (i.e.,  the  translational  position 
and  rotational  vector  77(f)).  Though  exact  knowledge 
of  the  disabled  vessel’s  masa,  Coriolis-centripetal,  and 
damping  matrices  is  not  desirable,  the  focus  of  this  work 
is  more  aligned  with  the  study  of  the  influence  and 
compensation  of  other  swarm  vehicles  on  the  disabled 
vessel  dynamics. 

Due  to  the  swarm’s  decentralized  architecture,  a  force 
allocation  methodology  [5]  will  not  be  feasible  as  each 
swarm  vessel  is  not  aware  of  the  other’s  location,  ori¬ 
entation,  and  thrust  magnitude  (i.e.,  the  control  force 
required  for  dynamic  positioning  and/or  tracking  will 
not  be  optimally  distributed);  therefore,  the  influence  of 
other  swarm  vehicles  will  be  viewed  by  each  swarm  mem¬ 
ber  as  a  bounded  disturbance  and  addressed  through  the 
development  of  a  robust  control  structure. 


B, 


sin  ai 
cos 

-liy  COS  Q.i  +  lix  sin  Ui 


1  <i<N  (7) 


where  liX,hy  £  R1  represent  the  distance  from  the 
disabled  vehicle’s  center  of  mass  to  the  ith  swarm  vehicle 
contact  point,  cq  £  R1  denotes  angle  at  which  the  ith 
swarm  vehicle  force  is  applied,  and  u  £  RArxl  is  the 
swarm  vehicle  input  thrust  vector. 


V.  Problem  Formulation 

In  this  phase  of  the  project,  the  objective  is  to 
develop  a  yaw  (ip  (t)  £  R1)  tracking  control  scheme  for  a 
disabled  vessel  actuated  through  N  autonomous  vehicles 
spaced  at  fixed  points  surrounding  the  vessel  (constant 
B  matrix).  It  will  be  assumed  that  the  autonomous 
vehicles  are  securely  attached  to  the  hull  of  the  disable 
vessel  in  a  manner  so  as  to  provide  both  forward  and 
reverse  thrust  directions.  In  addition,  a  decentralized 
architecture  within  the  swarm  is  assumed;  therefore,  each 
swarm  vehicle  will  only  be  aware  of  the  disabled  vessel’s 
position  and  orientation  as  well  as  its  relative  location 
from  the  disabled  vessel’s  center  of  mass  (i.e.,  1{X  and  ky). 
Our  objective  here  is  to  design  a  generic  swarm  vehicle 


VI.  Control  Design 

After  taking  the  time  derivative  of  (8)  and  substituting 
in  the  translational  kinematics  of  (5),  the  open- loop 
tracking  error  dynamics  for  e ^  (<)  are  given  by  the 
following  expression 


4  =  [  0  0  1  ] 

=[o  0  1] 


[-S  (ip)  RTip  (77  -  77J  +  V 

-RTv  d] 

j -SW^  +  M-'e, 

+  (M-1  -  I3)  RTrld] 


(9) 


where  we  have  utilized  the  fact  that  R  (ip)  = 
R(ip)  S  the  skew-symmetric  matrix  S  (ip'j  £  R3x3 
is  defined  in  the  following  manner 


S 


0  ip  0 
-ip  0  0 
0  0  0 


(10) 


and  the  term  M~1RTrjd  has  been  added  and  subtracted 
to  the  right  hand  side  of  (9),  velocity  tracking  error  signal 
ev  (t)  £  R3  has  been  defined  in  the  following  manner. 

e„  =  Mv  -  RTf]d.  (11) 
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After  taking  the  time  derivative  of  ev  (t)  and  substituting 
in  the  dynamics  of  (5),  the  open- loop  linear  velocity 
tracking  error  dynamics  can  be  expressed 


Since  orientation  tracking  of  the  disabled  vehicle  is 
considered  the  primary  objective,  the  swarm  vehicle 
control  input  takes  the  form  of  the  following  expression 


e„  —  S 


ev  —  (7  (v)  v  —  Dv  +  S  ( )  RTVd 


—R  +  Fs  +  BjUj. 


(12) 


[001]  BiUi  =[001 
(—liy  COS  ai  +  lix  sin  a*)  Uj  =  [0  0  1 


T 

T. 


(18) 


where  the  definition  of  (11)  has  been  utilized.  Due  to 
the  decentralized  approach,  the  term  Bu  of  (5)  has 
been  separated  into  two  components:  i)  the  disturbance 
resulting  from  the  influence  from  other  swarm  members 


In  order  to  prevent  loss  of  control  influence  into  the 
rotational  dynamics,  the  azimuth  angle  must  be  selected 
to  avoid  the  following  singularity  condition 


JV-1 


Fs  =  Bjuj  G  R3and  ii)  the  control  input  of  the  ith 

j= 

vehicle  B*Ui.  In  addition,  the  swarm  disturbance  force 
is  considered  to  be  bounded  in  the  sense  that 


a,  7^  tan  1  ( 

.  Hx 


(19) 


F„  >  IIF, 


(13) 


Ensuring  that  the  condition  of  (19)  is  satisfied,  the 
swarm  vehicle  thrust  input  it,;  (t)  can  be  calculated  in 
the  following  manner 


where  Fs  represents  a  known  upperbound  on  the  force 
disturbance  which  can  be  approximated  through  summa¬ 
tion  of  each  swarm  member’s  maximum  thrust  applied 
at  a  maximum  radial  length  from  the  disabled  vessel’s 
center  of  mass.  Future  research  will  target  the  relaxation 
of  knowledge  of  Fs. 

In  order  to  simplify  the  control  design,  the  filtered 
orientation  tracking  error  signal  (t)  £  R1  is  defined  in 
the  following  manner 


Ui  = 


0  0  1' 


(-liy  cos  ai  +  lix  sin  ai) 
VII.  Stability  Analysis 


(20) 


=  0  0  1 


cx.er 


(14) 


where  r  €  R6  denotes  the  3-DOF  filtered  tracking  error 
signal,  ael1  denotes  a  positive,  scalar  control  constant. 
The  open-loop  filtered  tracking  error  dynamics  for  ( t ) 
are  formulated  by  taking  the  time  derivative  of  (14), 
substituting  in  the  open-loop  expressions  of  (9)  and  (12) 
and  can  be  expressed  in  the  following  form 


The  swarm  thrust  input  Uj  ( t )  of  (20)  guarantees  that 
the  rotation  tracking  error  signal  (t)  is  exponentially 
driven  into  an  arbitrarily  small  neighborhood  about  zero 
in  the  sense  that 

||ev-(t)||  <  V(0)exp  +  £  (21) 

where  A3,  A2,  £  £  5?1  are  positive,  scalar  constants 
(explicitly  defined  in  the  subsequent  proof). 

In  order  to  illustrate  the  tracking  result  of  (21),  the 
following  non-negative  scalar  function,  denoted  by  V  (t), 
is  defined  as  follows 


V  =  \r. 


f$=  001 


-S 


1 

—ev  Qev, 


(22) 


r  —  C  (v)  v  —  D(v)' 


+S 


RTild  ~  RTVd  +  Fs  +  r  +  (Bjttj  —  t)  where  the  matrix  Q  = 


3x3 


and  V  ( t ) 


—aM  1ev  +  a  (M  1  —  /3)  RTr)d] 

(15) 

where  t  (t)  £  R3  has  been  added  and  subtracted  to 
the  right  hand  side  of  (15).  Based  on  the  structure  of 
the  open-loop  system  of  (15)  and  the  ensuing  stability 
analysis,  the  3-DOF  control  input  vector  r  (t)  is  designed 
in  the  following  manner 

r  =  C  (v)  v  +  D  (v)  v  -  S  (i>)  RTr/d  -  RT:f]d 


0  0  0 
0  0  0 
^001 

can  be  upper  and  lower  bounded*  by  the  following 
inequality 


Ai  ||z||  <  V  <  A2  \\z 

rT  ] T  £  R6 

parameters  Ai,  A2  £  R1  are  given  by 

1 


where  z  = 


I  (23) 

and  the  constant 


+aM  1ev  —  a  (M  1  —  I3 )  RTfid  —  M  1ev 
-ksr  -  knr 

(16) 

where  ks,kr  £  R1  denote  positive,  control  constants. 
After  substituting  (16)  into  (15),  the  open-loop  filtered 
tracking  error  dynamics  can  be  rewritten  as  follows 


Ai  =  min  -Ami„  (Q) 


,  A2  =  max  \  ~  Amax  (Q) 


f^,=  [0  0  1  ]  [-S  (i u> )  r  —  aM  1e„ 

+a  (. M~x  -  I3)  RTr]d 
+  (Fs  -  knr)  -  krr]  . 


(24) 

where  Am;n  {Q}  denotes  the  minimum  eigenvalue  of  the 
matrix  Q.  After  taking  the  time  derivative  of  (22), 
substituting  in  the  closed-loop  dynamics  of  (17)  and 
(9),  and  cancelling  common  terms,  the  time  derivative 
of  V  ( t )  is  given  by  the  following  expression 


(17) 


V  =  rT  [-kr r+  (Fs  -  kn r)] 

+e^  [-M~1aev  +  a  (M-1  -  /3)  RTf]d] 


(25) 
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After  applying  the  nonlinear  damping  argument  [4]  to  the 
parenthetical  term  of  (25),  the  time  derivative  of  V  ( t ) 
can  be  further  upperbounded  in  the  following  manner 


V  =  —  I  Av  —  t—  I  Hr 


-  (a\min  {QM-1}-^ 


(26) 


where  Amin{-}  denotes  the  minimum  and  £\,s  £  K1 
represent  positive  bounding  constant  defined  as 


£  > 


Qa  (. M  1  -  J3)  RTr)d 
2ei 


If  the  control  gains  are  selected  to  ensure  that 


,  .  Fs  .  e\ 

k“  >  -  rv  - 

r-kn  ’  -  2Amin  {QM-i} 


(27) 


(28) 


then  the  time  derivative  of  V  ( t )  can  be  upperbounded 
in  the  following  manner 


V  <-A3||z||2  +  £<-^F  +  £ 

A  2 

where  A3  £  K1  is  defined  in  the  following  manner 

.2' 

A3  =  min 


(29) 


kr  -  ®  ,  ^aAmin  {QM-1}  -  y)  }  • 

(30) 

Linear  arguments  can  be  applied  to  (29)  to  obtain  the 
exponential  result  of  (21)  in  the  sense  that 

\\eip  (£)||  <V(t)<V  (0)  exp  +e.  (31) 
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VIII.  Conclusion 

In  this  paper,  a  robust  control  strategy  that  achieves 
orientation  tracking  control  of  a  disabled  vessel  through 
the  utilization  of  a  swarm  of  vehicles  operating  in  a 
decentralized  fashion  has  been  presented.  The  control 
algorithm  implemented  on  each  swarm  vehicle  requires 
knowledge  of  the  disabled  vehicle’s  position  and  orienta¬ 
tion.  The  influence  of  the  other  swarm  vehicle  was  treated 
as  a  force  disturbance  into  the  model  dynamics.  Future 
research  will  consider  the  exploration  of  the  integration 
of  subtask  objectives  through  techniques  inspired  from 
redundant  robotic  manipulator  research  [1]  which  may 
allow  for  such  benefits  as  increased  damping  effects 
within  the  translational  dynamics  [2] .  In  the  real  system, 
it  is  difficult  to  estimate  the  attachment  point  of  the 
swarm  members  and  their  relative  orientation,  making 
the  B  matrix  difficult  to  exactly  compute.  Therefore, 
another  area  of  research  interest  is  the  development 
of  an  adaptive  yaw  tracking  controller  that  is  able  to 
compensate  for  the  unknown  parameters  associated  with 
the  input  related  matrix  B. 
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